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Abstract 
Introduction. The problem of controlling the lower-extremity powered exoskeleton motion was investigated. To solve 


it, it was proposed to use a program control and feedback control. The formation of control in the form of feedback 
required an assessment of the state of the exoskeleton (rotation angles, angular velocities, and accelerations of the 
links). The possibility of using an inertial measuring unit to estimate angular velocities and accelerations of exoskeleton 
links was considered. The work objective was to develop laws for the formation of the exoskeleton motion control, 
which could provide the stability of the program motion and use the measurements of encoders, micromechanical 
gyroscopes and accelerometers. 

Materials and Methods. Previously performed mathematical modeling of the exoskeleton dynamics was used to form a 
program control. It was proposed to equip the exoskeleton with inertial sensor units. This solution made it possible to 
evaluate the state vector of the exoskeleton and to use these estimates in a feedback loop. A mathematical model of 
measurements of these sensors was described. The proposed version is suitable for control systems of three-link 
exoskeletons of the lower extremities and can be expanded to the case of multi-link exoskeleton designs. 

Results. New laws of exoskeleton motion control based on a mathematical model of the system dynamics and using 
measurement information from encoders and inertial information sensors were proposed. Numerical simulation of 
exoskeleton motion was performed in the Wolfram Mathematica mathematical package. Its results confirmed the 
operability of the proposed control and the possibility of using an inertial sensor unit to assess the exoskeleton state. 
The numerical simulation results for the following program movements were presented: lifting the exoskeleton from a 
sitting position to a vertical position, and stabilization of the vertical equilibrium position. 

Discussion and Conclusions. The proposed control can be applied in exoskeletons for medical purposes, e.g., in the 
task of verticalization of patients with dysfunctions of the musculoskeletal system. The possibility of using 
measurement information obtained from inertial measurements units in the problem of estimating the state of 
exoskeleton links was demonstrated. The use of inertial sensors will make it possible to determine the angular 
acceleration of the exoskeleton links, avoiding numerical differentiation of the measurement information received from 
the encoders. The obtained estimates of angular acceleration allow us to introduce feedback on angular accelerations 


into the control system, which opens up the possibility of improving transients in controlling the exoskeleton motion. 
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Introduction. The development of devices designed to facilitate motion and increase motor efficiency (of 
exoskeletons) is perspectives for development robotics. 

Exoskeletons are increasingly used in industry [1], military [2], medicine [3], and other fields. This specifies 
topicality of the research on their circuit and structural design, energy consumption optimization, motion trajectory, 
dynamics, control. 

The present paper considers an active lower-extremity powered exoskeleton of a human with a rigid structure of the 
load-bearing frame. It is used for the rehabilitation of the musculoskeletal patients. 

The development of such exoskeletons requires solving interrelated scientific and technical problems. They include: 

— formation of a skeletal scheme; 

— mathematical modeling of exoskeleton motion [4-6]; 

— optimization of the links motion based on a mathematical model of kinematics and dynamics’; 

— reasonable construction of the motor system [7, 8]; 

— reasonable construction of the motor system [9—11] and estimation [13, 14]. 

All of the above tasks are connected by the problem of finding control actions for program motion. Firstly, their 
source may be the dynamic model of the system. Secondly, they are developed in the form of a proportional integral- 
differential (PID) controller used to stabilize the program motion. A combination of two methods is also possible. At 
that, for the formation of feedback control (in particular, in the form of a PID controller), algorithms for assessing the 
state of a dynamic system and a set of sensors whose indicators are used in algorithms, play an important role. 

To obtain information about the position of the exoskeleton links, they are equipped with an encoder or gyroscope 
[9-14]. Other possible options include accelerometer, magnetometer, potentiometer, sensors of torque, force, biosignals, 
etc. 

In [13], it is proposed to use one block of inertial sensors consisting of gyroscopes and accelerometers on each link 
of the exoskeleton. This solution will provide estimating the angles of rotation, angular rates and accelerations. At the 
same time, the measurement model turns out to be nonlinear, which complicates the structure of control and monitoring 
systems. 

The study aimed at improving the control of the exoskeleton by using two inertial blocks attached to each link of the 
exoskeleton. This approach enables to estimate the rotation angles, angular rates, and accelerations of the exoskeleton. 
With the help of the proposed arrangement of gyroscopes and accelerometers, a linear measurement model can be 


obtained, which will open up ways to simplify the control system and apply the theory of optimal evaluation of linear 
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systems [15]. This, in turn, will be the basis for improving the motion control of the exoskeleton. The criterion for 
improving the control quality is reducing the deviations of the angular rates of the links from the program movement. 
Materials and Methods. Consider the kinematic scheme of an exoskeleton with a rigid structure of the power frame 


with symmetrical movement of the legs in the sagittal plane (Fig. 1). 


Fig. 1. Kinematic diagram of the lower-extremity powered exoskeleton in the sagittal plane 
C2, C3, Cs — centers of mass of the lower legs, thighs and body, respectively; A), 42, 43 — joints connecting the 
links of the exoskeleton; @2, 3, @4 — rotation angles of the exoskeleton links; M2, M3, M, — control moments created 
by the actuators located in the joints A), A2, A3, respectively. Coordinate system xyz is introduced to describe the motion. 
x-axis is directed along the reference surface, y-axis is directed along the local vertical to the reference surface. z-axis 
complements the coordinate axes to the right Cartesian coordinate system. 


As a basis for building an exoskeleton motion control system, we use a dynamic model from [6]. 


A(q)4+F(q)q° +Dq+P(q)=M. (1) 
Here: 
Jy J, cos(@, —9;) J, C0S(, -@,) 

A(q)=| J,; cos(@, —9;) le J,, cos(@;—@, ) | — inertial force matrix; 

J,, cos(@; —@,) Jz, C08 (9; —9,) Jag 

0 J,, sin(@, —@;) J,,sin(@, —,) 

F(q) =| —J,, sin(~, —9;) 0 J,, sin(@; —,) | — speed force matrix; 

Soy sin(9, ~9,) Soy sin(@, —9,) 0 
D= diag(u,, L,5[ a) — diagonal matrix of dissipative forces characterizing linear friction in joints; 
P(q) = (M,. cos~, M,,cos@, M,, cos, y' — column vector of moments arising from the action of gravity; 


M= (M, —-M, M,-M, M, y — column vector of control torques generated by actuators located in the joints of 
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the exoskeleton links; q = (9, QP, Dy i — column vector of generalized coordinates, consisting of rotation angles of 
exoskeleton links; J jk ( ik =2, 3,4) — moments of inertia of exoskeleton links; 
Hy (k — 2,3,4) — coefficients of linear friction in the joints of the exoskeleton links; M,, (k = 2, 3,4) — maximum 


values of the moments of gravitational forces perceived by the output links of the drives. 


Let the laws of change of angles and their derivatives be given for program motion: 
PF =O, GF =O, G7 =). (1=2,3,4). (2) 
To control the exoskeleton motion, it is proposed to create control actions in the form of a sum of control moments: 


— with software management M/’ = M, (9° 67.67 ) (i = 2,3, 4) : 


—PID controller M;"” =M,(@/ —9,,6/ —6,.6 4, ),(i=2.3,4). 
M, =M3+M3", M,=M?+Mi”, M,=M;+M)”. (3) 
For program control, the values of control actions M/ can be calculated using the formulas [7]: 
Mi =Mg. cose +194 +5.G! +Jss| 8 cos(o% -o%)-(98)' sin(o! -0%) |+ 
+Jua| Gf c0s( of -o1)-(62) sin(o’ 0) | 


M3 =Mg; Coss +1565 + 5,65 + Js E cos(9} — 9; )-(@3) sin(e} -9)|+ 


(4) 
“i .p\2_. 
+ Jue] GF c0s( of -0!)+(6) sin(of -9') |+ Mi, 
Me=M P aes eee a Pop »p\? - ( pop 
2 = Mg. COS, FHP, +I,Q. +453) Pz COS(P, —P3 J +(P; } SIN|P, —; } |+ 
. <p\? 
+Jui| 6! c0s(! -of) +(0%) sin(o! ~9) | +M%. 
Values M/" are calculated according to the feedback principle (in the form of a PID controller): 
M’P =K f(g" b,)+Kp,(@) —@,)+K [(o2t,)-¢ (t,))dt 
4 D4 at D4 — D4 pa\P4 —P4 14 J (Pa) — Pah b 
0 
dyip_, Pp r/. : 
M;” =K,, dt (6; $s) Kp, (6; 6s) Ky, { (68 (t,) G3 (t,)) dt, + M2, (5) 
0 
dyip sp og Te 2 
M” =K,, races $,) Ky (65 -,)+K,, [(@5(t,) -@,(t,)) dt, + M2”, 
0 


or 


M;” =K,, (6: —6,)+ Koa (6; ~@,) Ky, (0 0,4), 
M;" =Kp, (6: —é,)+ Kp; (o; $3) +K 3 (9: 03) tM,” (6) 
M; =K,, (6; —G, ) +K,, (6; $2) Kp (9; 2) cM," 


Here, the coefficients of the PID controller Kp;, K;,, Kp; (i = 2, 3, 4) can be: 
— constant (they are found from the stability conditions); 
— time functions (found from solving optimal control problems [9, 13]. 
One of the problems of creation of control actions in the form of a PID controller is possible errors in the 


differentiation of measurement information. To avoid them, we use: 
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— encoders (for measuring the current rotation angles @, of the exoskeleton links); 
— inertial sensor blocks of micromechanical gyroscopes (for measuring angular rates @, ) and accelerometers (for 
estimating angular rates @, and accelerations 4, ). 
The model for measuring rotation angles using encoders can be presented as: 
PE2 =P2, Pes t+ Per =P3, Peg + Pe3 + Pps = Py, (7) 
where ,5,0 35,4 — indications of encoders located in joints A;, Az, A3 (Fig. 1). 
The model of angular rate measurements using micromechanical gyroscopes can be written as: 
Q67 =O, Q63 = 93, Qe =O, (8) 
where Q¢9, N63, Qe, — indications of gyroscopes attached to the links of the exoskeleton. 
To estimate angular rate and accelerations using accelerometers, a pair of two-axis accelerometers can be used, 


which are located at opposite ends of each of the links. They measure the apparent accelerations associated with the 
corresponding links in projections on x; y,-axis (i = 1, 2, 3). 
A A A A A A ‘ 2 a: 
Pala, =A = (ras, = as (i. avee ), = (103 13) : 
A A A A A A : 2 x 
we TR A = (Ges avis : Gen aye i. ~ (105 -165) 3 (9) 
c A c A c A : 2 r 
fac —fxvc = (Ge —fxvc ). ge —fxvc i = (1,0; -1,6,) : 
Here, fe, , fe. — vectors of readings of two-axis accelerometers mounted on link A,A, and located at points A, and 
"2 2 
A,, respectively; f; 4a) ie — vectors of readings of two-axis accelerometers mounted on link A,A, and located at 


points A, and A,, respectively; f aos ae — vectors of readings of two-axis accelerometers mounted on link A,C and 


located at points A, and C, respectively; J, =|A,A,|,/, =|A,A, 


,1,=|A,C| — distances between pairs of 


accelerometers attached to links A,A,, A,A, and A,C, respectively. 


We combine equations (7)-(9) and write formulas for estimating the angles of rotation, angular rates, and 


accelerations: 
> =Per> 93 =Pest+ Ger, Ps =PpatPe3+ Op, G2 =QG, G3 =QG3, Oy =QGu, 
(te,-the), (Bef), (Feet ao 
1 os 2 6 


a ¥3 
9, 1 » Qs L » D4 1, : 


To correct estimates of angular speed modules, the equations can be used: 


(Ey ~ Lara ). = 1,63, (i 7 re ), = L465, (fe a ie) - 1,04. (11) 


x3 
Thus, to estimate the rotation angles, angular rates and angular accelerations of the exoskeleton links, measurements 
can be processed with a moving average filter, Kalman filter algorithm, etc. [10, 13, 15]. 
In the simplest version of closing the feedback circuit when forming the control, we obtain expressions for the 


control moments: 
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(fc fat) 


M,=M;,+K,,| 4; 4 = 1+Kpy (6 05) Ki, (9: rs — Pes ®x2)> 


I, 
(ot 
M, =M; +K,,| 6; 4 i = |+Kos (6; Os) KK, (95 9x3 2) +My”, (12) 
2 
fh fA 
Mea + gb +O toh + Kya ($ Oca) Kia (0! 2) + ME. 
1 


The introduction of angular acceleration feedback into the control system provides the diagonalization of the 
inertial forces matrix to reduce the cross-influence between generalized coordinates. 

We simulate the exoskeleton motions to test the operability of the proposed control law. As a program motion, 
consider: 

— change of position from sitting to standing [7]; 

— stabilization of the vertical position of the exoskeleton with initial deviations of the links from the vertical. 

Research Results. For numerical simulation of the system, we took the parameters of the mathematical model of 
the exoskeleton from [6, 7]. We considered a special case by choosing the same coefficients of the PID controller for 
each drive: K,, =1,000N-m-s, K, =1,000N-m, K,,=0N-m/s(i=2,3,4). Figure 2 shows the time dependences 
for the rotation angles and angular rates of the exoskeleton links. They were obtained at control moments corresponding 
to rising from a sitting position. As can be seen from Figure 2 a, at the end of the motion, the rotation angles of each 


link are equal ©, =@, =@, =90° , which corresponds to standing. 


Q;° 


150 


100 


50- 


a) b) 
Fig. 2. Simulation results of rising from a sitting position without initial deviations from the program motion in the angles 


of rotation of the exoskeleton links: a — rotation angles of the links; b — angular rates of the links 


Now let us consider the case with deviations of about 20° in the rotation angles of the links compared to the initial 
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position set in the program motion. The simulation results of rising from a sitting position are shown in Figure 3. As in 
Figure 2, at the end of the motion time, the values of the rotation angles were equal to 9, =@,=@, =90°. 


Consequently, the use of a combination of software control and control in the form of a PID controller accurately 


brought the exoskeleton to the desired position. 209 
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6") 


150) 
100} 


50} 


a) b) 
Fig. 3. Simulation results of rising from a sitting position with initial deviations from the program motion in the rotation 
angles of the exoskeleton links: a — rotation angles of the links; b — angular rates of the links 
Thus, when modeling program motion, the operability of the proposed law of formation of control actions described 


in (4) and (12) was shown. 


The vertical position of the exoskeleton is unstable without control; therefore, disturbing factors can cause 


deviations from equilibrium up to the falling of the exoskeleton. 


We checked the operability of the proposed control in the task of stabilizing the vertical position of the exoskeleton. 
Values for the program motion were: 9% (t) = @4 (t) = 94 (t) = 90° . We considered the case when there were deviations 
of about 20° from the vertical position in the rotation angles of the links (Fig. 4). 


9;.° 
120+ 


o/s 


100} 


a) b) 
Fig. 4. Simulation results of stabilization of the vertical position with initial deviations from the program motion in the 


rotation angles of the exoskeleton links: a — angles of rotation of the links; b — angular rates of the links 
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Figure 4 shows that the proposed control provides stabilization of the vertical position of the exoskeleton links. 


For comparison, we present the results of modeling the stabilization of the vertical position using the following 


values of the coefficients of the PID controller: K,,=1,000 N-m-s, K, =1,000N-m, K,, =100 N-m/s (i= 2,3,4) 
(Fig. 5). 

@,.° 
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60! 
40; 


20 


a) b) 
Fig. 5. Simulation results of stabilization of the vertical position with initial deviations from the program motion in the rotation 


angles of the exoskeleton links: a— angles of rotation of the links; b — angular rates of the links 


It can be seen from Figure 5 that when using the differential link ( K,, #0) of the regulator, it was possible to 


reduce emissions in the dependences of the angular rates of the exoskeleton links compared to the case K,, =0 
(Fig. 4 5). 

Thus, the possibility of controlling the lower-extremity powered exoskeleton links using the readings of encoders 
and blocks of inertial sensors (micromechanical gyroscopes and accelerometers) was considered. The simulation results 
have validated this approach. 

Discussion and Conclusions. The proposed solution to the problem of controlling the motion of the exoskeleton 
can be used in medical applications, including for the verticalization of musculoskeletal patients. 

Thus, the data of the inertial sensor blocks can be used in the task of assessing the state of the exoskeleton links — 
their angular rates and accelerations. At the same time, there is no need for numerical differentiation of the measuring 
information of the encoders. Therefore, feedback on angular accelerations can be introduced into the control system, 


which makes it possible to improve transients when controlling the exoskeleton motion. 
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